/******************************************************************
简介：实现Mega2560扩展版声明舵机

引脚图说明：
  舵机标签编号          板载标识         引脚号
       无                 NC             空
       1                 PG5             4
       2                 PH3             6
       3                 PH4             7
       4                 PB4             10
       5                 PB5             11
       6                 PB7             13
       7                 PL3             46
       8                 PL4             45
       9                 PL5             44

日期：2024.11.29
QQ交流群：811348489
寄语：代码中能遇见你，真好，有你，真好.
署名：有你同创智能机器人科技(北京)有限公司.
******************************************************************/

#include "uni_servo.h"

//注意，这个方式目前最大支持20个舵机，后期会增加到最大支持50个舵机
//UNI_SERVO_S servo(4, 6, 7, 10); //声明引脚为4, 6, 7, 10的舵机
UNI_SERVO_S servo(4, 6, 7, 10, 11, 13, 46, 45, 44); //声明引脚为4, 6, 7, 10, 11, 13, 46, 45, 44的舵机

int ang1 = 60;
int ang2 = 120;

void setup() {
  delay(1500);
  Serial.begin(115200);
  servo.init();     //舵机引脚初始化
}

void loop() {
  servo.move(ang1, ang1, ang1, ang1, ang1, ang1, ang1, ang1, ang1);   //9个舵机转动到60度
  delay(1000);

  servo.move(ang2, ang2, ang2, ang2, ang2, ang2, ang2, ang2, ang2);   //9个舵机转动到120度
  delay(1000);

  /* 如果想要某个编号舵机单独运动，也可以指定舵机编号，让该编号舵机单独转动，如下所示
    servo.pin_move(4, 60);    //表示引脚为4号的舵机转动到60度
    servo.pin_move(4, 120);   //表示引脚为4号的舵机转动到120度
    servo.pin_move(45, 60);   //表示引脚为45号的舵机转动到60度
    servo.pin_move(45, 120);  //表示引脚为45号的舵机转动到120度
  */
}
